An Automatic Navigation System for Unmanned Surface Vehicles in Realistic Sea Environments

In recent years, unmanned surface vehicles (USVs) have received notable attention because of their many advantages in civilian and military applications. To improve the autonomy of USVs, this paper describes a complete automatic navigation system (ANS) with a path planning subsystem (PPS) and collision avoidance subsystem (CAS). The PPS based on the dynamic domain tunable fast marching square (DTFMS) method is able to build an environment model from a real electronic chart, where both static and dynamic obstacles are well represented. By adjusting the Saturation, the generated path can be changed according to the requirements for security and path length. Then it is used as a guidance trajectory for the CAS through a dynamic target point. In the CAS, according to finite control set model predictive control (FCS-MPC) theory, a collision avoidance control algorithm is developed to track trajectory and avoid collision based on a three-degree of freedom (DOF) planar motion model of USV. Its target point and security evaluation come from the planned path and environmental model of the PPS. Moreover, the prediction trajectory of the CAS can guide changes in the dynamic domain model of the vessel itself. Finally, the system has been tested and validated using the situations of three types of encounters in a realistic sea environment.